﻿/*                       NOTICE
 * 
 * This software was produced for the U. S. Government
 * under Contract No. FA8721-10-C-0001, and is
 * subject to the Rights in Noncommercial Computer Software
 * and Noncommercial Computer Software Documentation Clause
 * (DFARS) 252.227-7014 (JUN 1995)
 * 
 * Approved for Public Release: 11-2435
 * © 2011 The MITRE Corporation. All Rights Reserved. 
 * 
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 * 
 * http://www.apache.org/licenses/LICENSE-2.0
 * 
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */


using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using OSC.NET;
using TUIO;

namespace GRIP
{
    public class TuioSender
    {
        protected OSCBundle cursorBundle;
        int frame = 0;
        protected string type = "/tuio/3Dcontact";
        OSCTransmitter transmitter;
        private string Source;

        public TuioSender(string server, int port, string source)
        {
            transmitter = new OSCTransmitter(server, port);
            this.Source = source;
        }

        public void SendContacts(List<TuioContact> contacts)
        {
            List<long> livingContacts = new List<long>(contacts.Count);
            foreach (TuioContact contact in contacts)
                if (contact.active)
                {
                    OSCMessage message = new OSCMessage(type);
                    message.Append("set");
                    message.Append(contact.getSessionID());
                    message.Append(contact.getX());
                    message.Append(contact.getY());
                    message.Append(contact.getXSpeed());
                    message.Append(contact.getYSpeed());
                    message.Append(contact.getMotionAccel());
                    message.Append(contact.getZ());
                    message.Append(contact.getZSpeed());
                    cursorBundle.Append(message);
                    livingContacts.Add(contact.getSessionID());
                }

            OSCMessage aliveMessage = new OSCMessage(type);
            aliveMessage.Append("alive");
            for(int i = 0; i < livingContacts.Count; i++)
                aliveMessage.Append(livingContacts[i]);
            cursorBundle.Append(aliveMessage);

            OSCMessage endMessage = new OSCMessage(type);
            endMessage.Append("fseq");
            endMessage.Append(frame);
            cursorBundle.Append(endMessage);
            frame++;
            transmitter.Send(cursorBundle);
        }
    }
}
